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of  the  object.  The  configurations  forbidden  to  this  object,  due  to  the  presence  of  obstacles,  cun  then 
be  characterized  as  regions  in  the  Configuration  Space.  The  paper  presents  algorithms  for  computing 
these  Configuration  Space  obstacles  when  the  objects  and  obstacles  arc  polygons  or  polyhedra.  An 
approximation  technique  for  high-dimensional  Configuration  Space  obstacles,  based  on  projections  of 


obstacles  slices,  is  described. 
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IniMultKlion 


I.  Iniioihiction 

\n  increasing  unj;o  ol  lomptilet  applications  deal  with  models  of  two  .mil  ilttee  ilimiiisHnt.il 
objects.  In  those  applications.  objects  must  often  In'  pl.m'il  among  othci  rd'iccls  01  moved  in  such 
.1  way  mi  ill, n  no  mii'i li'ii'iiiv  liom  ncathv  objects  icmiIi  In  llm  papa.  these  tv  pcs  ol  pidhlcms 
.iii'  called  yuliiil  i>l,inn/>n;  piohlems.  Among  the  many  applications  when'  sp.uul  pi. mump  plays  .in 
mi|>or(.nit  role  arc: 

1.  I’l.  inning  the  layout  of.i  building  |S|.  i.e.  the  arrangement  of  walls,  corridors.  rooms,  and 
equipment  so  as  lo  fullill  a  user's  design  eonsiraints  as  well  as  implieil  consistency  constraints. 

2.  I‘l. inning  how  to  machine  a  part  using  a  Numerically  Controlled  Machine  fool  |  C|.  which 
lequnes  plotting  the  path  of  one  or  more  cutting  sui  laces  so  as  to  piodinc  the  desired  part. 

V  1*1. inning  tlie  layout  of  ail  1C  chip  |45J  so  as  to  mmimi/c  aiea.  subject  to  geometric  design 
constraints. 

4.  I’l. inning  how  to  assemble  a  part  using  an  industrial  robot  |IK]  |l‘l|  |tg|.  which  requires 
choosing  how  to  grasp  objciis.  uime  them  without  collisions  and  In  mg  them  into  contact. 

I’loblcnis  in  spatial  planning  genet  ally  iniohe  (at  least)  two  impoiianl  ly  pcs  of  considerations: 

1.  ( ieoinelrii  (  he  legal  solutions  must  he  chuiucieti/od.  which  invohes  considering  inter¬ 
actions  Ivtw  een  the  shapes  of  objects  and  obstacles. 

2.  Optimization  •  I  he  best  solution  must  be  chosen  from  among  the  legal  solutions. 

Ibis  paper  deals  primarily  w  ith  computing  constraints  on  the  position  of  an  object  due  to  the  presence 
of  obstacles,  thus  its  focus  is  on  the  geometric  aspect  ol  spatial  planning.  The  development  throughout 
will  be  based  on  polvhedr.il  object  models,  although  main  of  the  results  and  approaches  are  ap¬ 
plicable  to  other  classes  of  objec  t  models. 

Recently,  there  has  been  a  rapid  growth  of  interest  in  etlicienl  algorithms  for  geometric  problems. 
Trevious  work1  has  focused  on  algorithms  for  (1)  computing  comes  hulls  |‘>|  |1 2)  |IS]  |29|,  (2)  inter¬ 
secting  convex  polygons  and  polvliedra  |5|  |24|  J 3 .4 J  |3S|.  ( 1)  intersecting  half  spaces  |7|  1 30]  (4)  decom¬ 
posing  polygons  j3?|,  and  ($)  closcsl-poml  problems  1 34 J  Ibis  paper  formulates  two  other  geometric 

1  the  references  riled  here  are  representative  of  the  niirenl  lileiatme:  tnev  ate  tn  no  means  a  romplete  survey 
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piohloms  I  nuKp.ui'  Mid  I  nulp.ill)  mill  impoii.mi  .ippln  .ilions  in  sp.m.il  planning  dcsiiihcs  .in 
uppiouch  In  llu'ir  solution  .mil  picscnts  algoiiihms  lot  the  conii.il  piohlcm  posed  In  iln-  appioach 
hc\  inns  work  on  I  hose  piohloms  is  briolly  union  oil  in  Soolmn  1 1 . 


2.  Spatial  Planning  Problems 

I  oi  li  ho  .i  comes  polyhedron  ih.it  onni.nns  A;(  oilior.  possibly  ovoi  lapping.  con\o\  polyhcdr.i  H , 
designated  .is  h/iiwi  A  \.  I  oi  I  ho  tho  union  ot  Ar «  comes  polyhcdr.i  A,,  i.o.  I  U!  i  I  igmc 
1  illustrates  two  id.iloil  geomolik  piohloms.  defined  holow  (where  posiiion  is  usoil  in  mo.in  both 
u. nisi. iimn  .mil  oricnl.ilion): 

I.  liiidspaic  I  ind  .i  posiiion  lot  A.  nisiilo  //.  snohih.il  ViVj  .-l,  m/I,  0.  I  Ins  is  o.illod  ;i 
w/r  position. 

1.  I- iiulp;i(li  I  mil  .i  p.ilh  t*u  .1  from  position  .s  lo  position  </ siuh  lli.it  \  is.ilwav  m  l{  .nul  A 
no\oi  overlaps  am  ol  tho/J,.  I  Ins  is  o.illoil  a  %<//«•  p;ith. 

\  visions  ol  iho  I  nnlp.ilh  .mil  I  inilsp.uo  problems  ikyiii  in  ni.im  sp.m.il  pi. minin'  applications. 
I  or  ox.implo,  iho  .ippro.iohos  lo  object  layout  (lompl.ito  p.n. k mo>  in  |l|  |2|  |>|  .uni  |lt)|  .no  b.isoil  on 
solutions  to  lindspace  in  two  ilimonsions.  \lso.  s\ stems  lor  pingrnmtmng  iiulnsiii.il  lobots  using 
object  nioilols  |2U|  1 1S|  nnisi  sobo  }  ilinionsion.il  lindspace  .uni  I  unlp.illi  piohloms  wlion  choosing 
grasp  points  on  objects  oi  paths  loi  the  robot. 


V  I  ho  (  '.s;kic(  Approach  In  Spatial  Planning 

In  this  section,  an  oiomow  ol  tho  (  nntigiuntion  Space  approach  lo  spatial  planning  will  be 
presented.  Sections  $  through  10  discuss  the  approach  more  formally. 

The  posiiion  and  orientation  of  a  rigid  solid  can  be  represented  as  a  single  (>  dimensional  point, 
called  its  am/iguriiimn.  I  he  h  dimensional  space  of  configurations  tor  a  solid.  is  called  its 
Configuration  Space  and  denoted  ('sjxicc  \  l-'or  example,  a  configuration  may  base  one  coordinate 
'.due  lor  each  ol  the  r,  y, ;  coordinates  of  a  selected  point  on  the  object  and  one  coordinate  value  for 


!=— T 


llu  i  '/»« <  i .1  ‘.(i.iiul  I’I.iiiiiiiij’ 


I'i^uro  I.  The  definition  of  /?.  D,  and  4  for  lindspaec  and  l  in  ioatli  pmhloms  in  two  dimen¬ 
sions.  (a)  The  I indspare  problem  is  to  find  a  position  I'm  /I  wlv  '  Joes  not  meil.ip  an>  of  the 
11,.  (h)  I  lie  Imdspaee  problem  is  to  find  a  path  for  A  from  s  to  g  that  awnds  the B} . 
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limine  2.  Ihc  <  s/kki  (  obstacle  due  lo  II.  lor  fixed  orientation  of  A 

each  of  the  object's  filler  .ingles-’  .  In  general,  .in  ?i  dimension.il  configuration  space  cm  be  used  to 
model  ;»n>  system  that  can  be  cbar.icteri/ed  with  n  parameters.  An  example  is  the  configuration  of 
an  industrial  robot  with  n  joints,  where  n  is  tv picall)  5  or  b.  In  ('sjum  ».  the  set  of  configurations 
where  A  otri/upv  li  will  he  denoted  C'0\(lf),  the  Csj»acf\  Obuovh  due  to  H.  Similarly,  those 
configurations  where  1  is  completely  insult  H  will  be  denoted  C I t(/f).  the  ( '.spue.  t  Interior  of  B. 
Together,  these  two  ( 'space.  \  constructs  embody  all  the  information  needed  to  solve  lindspace  and 
I  indpalli  problems. 

If  die  orientation  of  a  convex  polygon  A  is  fixed.  C  space. \  is  simply  the  (x,  y)  plane.  ITiis 
is  so  because  the  (r,  y)  position  of  some  irfirc/nr  u-rtex  ri/(  is  sullicent  to  specify  the  polygon’s 
configuration.  In  this  case,  the  presence  of  another  convex  polygon  H  constrains  rv  x  to  be  outside 
of  CO\(ll).  a  larger  convex  polygon,  shown  as  the  shaded  region  in  1'igurc  2.  Thus,  the  l  indspace 
problem  can  be  transformed  to  die  equivalent  problem  of  placing  rv.\  outside  of  CO  *(/?).  but  inside 
C’1  \(R).  Similarly,  for  multiple  obstacles  Ii„  a  location  for  A  is  safe  ilf  rv  t  is  not  inside  any  of  die 


‘  Ihc  relative  mi.il ion  of  our  coordinate  svsiem  relative  In  annthor  can  hr  specified  in  trims  of  three  angles  usually 
irfcireit  In  as  l  ain  ancles  [4l|  'Ihcsc  ancles  indir.iic  the  inaumtudc  of  Ihier  successive  rotauons  about  specified  axes, 
hul  no  uniform  ronvcnlion  for  ihc  elioiee  o(  axes  exists 


llu  i  'i*i ii  Vppm.n  li  i(i  S|».itul  IM. 111111111 


|  iyni’  .V  llu  I  uid|tatli  inoldent  and  Us  formulation  using  tltc  <  'i  /<,)  llu  shnrlesl  mllisiou -free  paths 
connect  tin-  origin  anil  the  ilcsitiialion  via  die  'oil ices  of  llu  (  '( >  polygons 


<  ’0\(H,),  Inn  is  inside  ( '/  ((//).  Subsequent  seel  ions  discuss  algoiidum  lor  ( ’O  t(/f)  .uuU’/  \(/i). 

If  Ihe  orientation  ol  d  is  fixed,  (hen  die  l-indpalh  problem  lor  ibe  polygon  .1  among  the  B,  is 
equivalent  to  the  Imdpatfi  problem  for  die  point  rv\  umong  ihe  ('(){(li,)  When  the  ('(>\{B,)  ‘ire 
poll  guns.  the  shortest*  safe  paths  for  re*  are  piecewise  linear  pailts  connecting  the  start  and  the 
goal  via  the  vertices  of  the  CO  polygons,  f  igure  ).  I'hciclbre,  liiulpalh  can  be  formulated  as  a 
graph  search  problem.  I  he  graph  is  formed  b>  connecting  .ill  pairs  of  fO  venues  (and  die  start 
and  goal)  that  can  "see"  each  other,  i.c.  can  be  connected  by  a  straight  line  that  does  not  intersect 
any  of  the  obstacles.  The  shortest  padi  from  the  start  to  the  goal  in  this  visibility  graph  (V graph)  is 
die  shortest  safe  path  for  A  among  die  B,  |2IJ.  This  algorithm  efficiently  solves  I  indpath  problems 
when  the  orientation  of  A  is  fixed,  but  the  paths  ii  finds  are  very  susceptible  to  inaccuracies  in  the 
object  model.  These  paths  touch  the  Cspaa.  *  obstacles,  therefore  if  the  model  were  exact,  an  object 
moving  along  tins  type  of  path  would  just  touch  the  obstacles.  Hut  an  inaccurate  model  may  result  in 
a  collision.  I  urthcr.norc.  the  V  graph  algorithm  wuh  three-dimensional  objects  and  obstacles  docs  not 
find  optimal  paths. 

'litis  assumes  furlidran  dtslanrc  as  a  mclnr  I  m  Ibc  optimality  mndiliotis  using  a  ui  lilincar  (Manhaiian)  mclnc.  see 
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I'il'iirc  4.  Slice  pri'K-rlmn'>  of  (  ‘h/mm  t  ohil.uk".  rompuud  using  the  (.r.  i/)-:iic:i  svvipi  om  bv  t  cner  a 
i, mil  of  0  \aliii-'  I  aih  nf  ihi  slindiil  obstacles  is  llic  (  r.  i/)  projection  of  a  P  slice  ol  (  ' \{H)  Hie  figure 
also  shims  a  pohgiMi.il  .ippioviinaiion  lo  llic  slice  piojcclion  and  die  polvgonal  approximation  lo  die  swept 
loliinic  Iioiii  which  il  derives 


When  A  is  a  three-dimensional  solid  which  is  allowed  to  rotate,  (y)\(H)  is  a  complicated  curved 
object  in  a  6-dimensional  Csjmce\.  Ru Ilia  than  compute  these  olrjects  dircctb .  the  approach  taken 
here  is  to  use  a  sequence  of  two-  and  three-dimensional  projections  of  the  high-dimensional  Cspace  \ 
obstacles.  In  particular,  the  6  dimensional  Csparex  obstacles  for  a  rigid  solid  can  be  approximated 
by  several  3-dimensional  projections  of  CO  slices.  A  j  slice  of  an  object  C  t  !R’‘  is  defined  to  be 
{(/?!,  .,  P„)  G  C  |  7,  <  Pj  <  V,  }•  where  %  and  ^  arc  the  lower  and  upper  bounds  of  the  slice, 

respectively.  Then,  if  K  is  a  set  of  indices  between  1  and  n.  a  /T-slicc  is  (he  intersection  of  all  the  j- 
slices  for  j  t  K.  Notice  that  .i  K- slice  of  C  is  an  object  of  the  same  dimension  as  C .  Slices  can  then 
be  projected  onto  those  coordinates  not  in  K  to  obtain  objects  of  lower  dimension. 


As  an  example  of  the  slice  projection  technique.  Figure  4  shows,  shaded,  the  ( z ,  y)  projection  of 
0-sliccs  of  CO  \(/l)  when  A  and  /?  arc  convex  polygons  These  slues  represent  configurations  where 
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.4  overlaps  B  lor  some  oiiciiiaitoh  ol  A  in  (lie  specified  ranee  of  0.  Section  10  shows  that  these  slice 
projections  are  the  <  'spaa  ,  obstacles  of  the  area  (\olumc)  swept  out  In  1  met  the  ranee  of  orienta¬ 
tions  of  the  slice.  Note  that  approximating  the  swept  \ohimc  as  a  pnlyhcdion  leads  to  a  polyhedral 
approximation  lor  the  projected  slices,  as  shown  in  figure  4. 

The  slice  projection  technique  has  two  important  properties: 

1.  A  solution  to  a  I’indspace  problem  in  any  of  the  slices  is  a  solution  to  the  original  problem, 
hut  since  the  slices  are  an  approximation  to  the  Cspace  obstacle,  the  cometse  is  not  necessarily 
tntc. 

2.  I  he  slice  piojection  of  C space  i  obstacle  can  be  computed  without  basing  to  compute  die 
high  dimensional  ( 'space  \  obstacle,  see  Section  10. 

I  he  slice  projection  method  can  also  be  used  to  extend  the  V graph  algorithm  described  earlier  to 
find  safe  (hut  sub-optimal)  paths  when  rotations  of  A  are  allowed  |2I  j.  A  number  of  slice  projections 
of  the  C space  obstacles  are  constructed  for  different  ranges  of  orientations  of  A.  Ihe  problem  of 
planning  safe  paths  in  the  high-dimensional  Cspace  \  is  decomposed  into  (a)  planning  safe  paths 
\ia  CO  vertices  within  each  slice  projection  and  (h)  moving  between  slices,  at  configurations  that 
are  safe  in  both  slices,  both  of  these  types  of  motions  can  he  modelled  as  links  in  the  Vgraph. 
therefore  the  complete  algorithm  can  he  formulated  as  a  graph  search  problem,  t  his  approach  is 
illustrated  in  figure  V  I  lowevcr.  the  Vgraph  algorithm  has  several  draw-backs  when  the  obstacles  are 
'  dimensional.  In  particular. 

1.  Optimal  paths  in  higher  dimensions  do  not  typically  traverse  the  vertices  of  the  Cspace 
obstacles. 

2.  In  higher  dimensions,  there  may  he  no  paths  via  vertices,  within  the  enclosing  polyhedral 
region  It.  although  other  types  of  safe  paths  w  ithin  R  may  exist. 

These  drawbacks  may  be  alleviated  by  introducing  additional  nodes  in  the  Vgraph  which  do  not 
correspond  to  vertices  (21).  An  alternative  strategy  to  finding  safe  paths  in  ('space ,  is  discussed  in 
|20). 

Ihe  key  to  the  Cspace  approach  outlined  above  is  computing  the  Cspace  obstacles;  the  rest  of 
the  paper  is  devoted  to  this  problem. 


\nl;ilum  .uni  (  imunhons 


|  »l»mc  5.  \n  ilhiMciiion  of  die  I  mdpadi  ;ilg<>iidnn  using  slue  projection  dcscidvd  b>  I  o/ano -Pore/  and 
Wcslcv  in  PI]  \  mimhci  nl  slice  piojccinms  ol  ihc  <  obstacles  are  const  ruiicd  foi  dilleienl  ranges 

of  oiieiUanoiis  of  \  Iho  problem  ol  planning  silo  paths  m  the  hit'll  dimensional  <  *  is  decomposed 

into  (I)  planning  sife  paths  \ia  <  '<  >  \  cilices  within  each  slice  pmjcciion  and  (?)  inoMiig  between  slices,  at 
ronfigoi.it ions  that  ate  site  in  both  slices  tj  represents  \  m  its  initial  configuration  \*  icpiescnis  \  in  its 
linn!  coiiliguralion  and  \*  is  a  simple  poKItedral  approximation  to  die  swept  uilume  ol  I  between  its  initial 
and  final  orientation 


4.  Notation  ami  Conventions 


All  geometric  entities  points,  lines,  edges,  planes,  laces  and  objects  will  he  treated  as 
(infinite)  sets  of  points.  All  of  these  entities  will  be  in  the  /c  dimensional  real  I  uelidean  space,  a. 
b.  i,  and  y  shall  denote  points  of  IR1 .  as  well  as  the  corresponding  vectors.  A.  If.  and  ( ’  shall  denote 
sets  of  points  in  5?,t.  while  /  and  K  shall  denote  sets  of  integers.  ~f.  9.  and  ji.  shall  denote  reals,  while 
n,  i,j,  k  shall  he  used  for  integers.  Ilic  coordinate  representation  of  a  point  r  £  3R".  for  any  n.  shall 
he  c  =  (■),)  =  (“Trip  -  -  ■ .  I..)  The  magnitude  of  a  vector  a  w  ill  be  ||a||  and  the  cardinality  of  a  set  A 
will  be  |/l|.  The  scalar  (tint)  product  of  vectors  a  and  b  will  be  denoted  (a,  b). 

lire  following  operations  arc  defined  on  sets  of  points  in  Rn: 
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l-igurc  f>  linked  Polvlvdia  (.111  he  iued  to  model  the  uro>s  ecornem  of  manipulators 

A  011  -  {a -f  b\a£A,b€B) 

0.A  --  {  —a  |  a  G  A  } 

II. 1  sol  A  consists  ofa  single  point  a.  then  <10//  -  {«}0//  *  A  4) /I.  Also.  A  0/1  —  A0(0//). 
Solo  di.ii.  (ipicnlly  A  0  A  {  2«  |  a  t  A  }  ami  -1  0  A  ^  0.  although  A  0  //  =  //  0  A.  I'he  sel 
dilhreme  aiul  sol  complement  opoi.uions  will  ho  denoted  A  —  //ami  A  respectively. 

Rigid  objects  will  ho  represented  as  sols  of  possibly  ovciliippin, g  comet  pnl\  luJio  since  ill  is  repre¬ 
sentation  simplifies  iho  algorithms  lor  computing  ( ’().  I  hooroin  I  below  tollows  directly  from  the 
definition  off '():  u  justifies  iho  use  of  this  object  representation. 

Theorem  I:  If  A  --  '  i  and  13  =  Uj!Lt  Bj- 

CO\(l3)  —  uu 

.  i  j  i 

The  position  and  orientation  of  a  polyhedron  will  he  defined  relative  to  an  initial  position  and 
orientation.  In  this  initial  position,  some  vertex  of  the  polyhedron  coincides  with  the  origin  of  the 
global  coordinate  frame.  I'or  a  polyhedron  this  vertex  is  called  the  rrjrmur  vernw  ofP,  or  rv/>. 

In  the  sequel,  a  dilfcrcnt  kind  of  object,  called  I  inkcJ  polylirJm.  is  used.  These  objects  arc 
kinematic  chains  with  polyhedral  links  and  prismatic  or  rotary  joints’  figure  ft.  The  relative  position 

1  lomis  ;ire  rijnisonli-d  ahsitatlls  u  then  representation  as  polxhcdta  (In  not  determine  ihoir  million  properties  In 
paniuilar.  some  rallies  of  me  joint  parameters  max  cause  overlap  of  adjacent  links 
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.nut  orientation  of  adjacent  links.  A,  ;nul  A,  ,  |.  is  determined  In  the  ilh  joint  pauntetir  (angle) 

I  he  sol  of  joint  parameters  of  a  linked  polyhedron  completely  specifies  the  position  and  orientation  of 
all  the  links. 


5.  (  onligiiralion  Space  and  C space  Obstacles 

The  configuration  of  a  A-dintensional  polyhedron.  A,  is  a  point  a  =  (-n,  G  Si'1.  withef  = 

k  |  (‘);  where  ('y)> .  . . ,  *j/.)is  the  position  of  rv  \  and  ("?(,  j- 1,  • ,  ~u)  are  the  hitler  angles  specifying 

the  orientation  of  A  relative  to  us  initial  orientation.  The  configuration  of  a  linked  polyhedron  having 
d  joints  is  the  d- vector  of  the  joint  parameters.  The  d -dimensional  sp.iec  of  configurations  of  A  is 
denoted  Cspace  (.  A  in  configuration  x  is  (,d)j ;  A  in  its  initial  configuration  is  (/t)0. 

The  fundamental  observation  about  Configuration  Space  is  that,  in  Caprice  4.  the  (/l)x  is  repre¬ 
sented  by  the  vector  x.  Given  this,  the  basic  problem  in  the  Cspace  approach  to  spatial  planning  is  to 
define  how  the  obstacles  B,  map  into  Cspacc  \.  The  mapping  chosen  here  exploits  two  fundamental 
piopcrtics  of  objects:  'I  heir  rigidity,  which  allows  their  configurations  to  be  characterized  by  a  few 
parameters,  and  their  solidity,  which  requires  that  a  point  not  be  inside  more  than  one  object. 

Definition:  I  hc  Cspacc  y  obstacle  due  to  B.  denoted  CO  ((/i).  is  defined  as  follows: 

CO  y(B)  =  {  x  G  Cspace  ,  |  (A)s  n  B  ^  0  } 

lluis.  if  x  £  CO\[B)  then  {A)s  and  B  cither  touch  or  overlap.  Conversely,  any  configuration 
x  £  CO  (for  all  obstacles  X)  is  safe.  The  following  defines  a  Cspacc  *  entity  complementary  to 

com 

Definition:  The  Cspace  \  interior  of  B.  denoted  Cl\(B),  is  defined  as  follows: 

Cl.\(B)  =  {x  E  CspaceA  j  (A)x  CS} 

Ihc  sets  COy(B)  and  CI\(B)  arc  difficult  to  compute  and  manipulate  since  they  arc  curved, 
6-dimensional  objects  when  A  and  B  arc  polyhedra.  Instead,  this  paper  will  deal  with  projections 
of  slices  and  cross-sections'’  of  CO\(B).  Tor  example,  for  fixed  Kulcr  angles  of  A.  the  CspaceA 
'A  cross-section  is  a  slice  whose  lower  and  upper  hounds  arc  equal. 
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obshk/lo  iluc  u>  /*  i''  ilcnoUil  uulic.iiin^  ih.ii  ii  is  *i  set  <»f  xyz  positions,  r.iihcr  th.m  the 

lull  i oufiLM iitii iuiis.  < '( >\‘‘  {II)  i'  the  projection  unto  the  x,  y,z  couhnatc-  of  ,m  I  ulci  .ingle  cross- 
sci  non1'  In  gcnei.il,  the  supciv  lipt  int  ’()  .mil  (  7  w  ill  imlic.ite  the  comp.  .sitiou  of  their  members, 
e.g.  (  'O ',"(/()  ;ukI  ( '"{II)  denote  sets ol(x,  y)  .uni  (x,y,0)  \ .ilues  respectively . 


ft.  rite  Sliding  Algorithm  fo rCOIy 

Ibis  section  presents  .1  "u.me"  algorithm  for  computing  OOr, •'(£?)  when  A  and  Ii  are  convex 
polygons  and  the  otieiitation  of  A  is  fixed.  In  subsequent  sections,  mote  efficient  algorithms  are 
presented  for  this  case. 

When  the  orientation  of  A  is  fixed,  the  configurations  of  A  are  simply  the  positions  of  the 
reference  vertex  ro,.  Clearly,  (he  boundary  o f  CO\(D)  is  the  locus  of  rr,  where  A  just  touches  B. 
This  suggests  a  simple  algorithm  for  computing  OOj(‘'(/?):  slide  A  around  the  perimeter  of  II  and 
trace  the  path  of  re,.  Hie  term  v/n/mg  is  merely  suggestive;  in  practice,  knowing  which  vertex  first 
touches  an  edge  completely  defines  the  path  of  rt_> ,  over  that  edge. 

I  he  central  step  of  this  .SV/d/ng  u/gm/t/mi  is  to  determine  what  point  (or  edge)  of  A  first  contacts 
each  edge  of  13  and  vice  irr.su.  f  igure  7.  The  normal  vector  ol  each  edge  of  I)  defines  an  approach 
direction  for  me  edge.  If ‘A  is  moving  from  a  great  distance  towards  an  edge  of  II  along  the  normal 
direction,  and  no  edge  of  A  is  parallel  to  one  off?.  then  contact  will  lirsi  happen  at  a  vertex  of  A.  This 
contact  vertex  is  the  one  witli  the  minimum  perpendicular  distance  to  the  edge  of  B.  As  this  vertex 
"slides”  along  the  edge  of  II.  n ,  traces  an  edge  of  ('0"'(B)  which  is  parallel  to  the  edge  of  II  and 
of  equal  length,  lint  this  edge  is  displaced  by  the  del.,  cc  troin  the  contact  vertex  to  rv ,.  projected 
along  the  normal  to  the  edge  ol’/f.  Interchanging  the  to.  s  of  A  and  II  shows  that  each  edge  of  A  and 
some  vertex  of  II  gives  rise  to  an  edge  of  ( 'O', "(/?).  i !  new  edge  is  traced  out  by  rv.\  as  the  edge 
of  A  "slides"  along  tile  contact  vertex  ol  II.  u:  me  ...  new  edge  is  parallel  to  the  edge  of  A  and 
of  equal  length,  but  displaced  from  the  contact  vertex  .it  II  by  the  perpendicular  distance  between  the 
edge  and  rv.\.  If  A  and  II  have  pairs  of  parallel  edges,  then  CO ',''(/?)  will  have  .1  parallel  edge  for 
each  such  pair,  displaced  as  above,  but  whose  length  is  the  sum  of  the  two  edges. 

BWhen  V'  orientation  is  fixed,  we  assume  without  loss  of  generality  dial  1  is  in  its  initial  orientation,  ic  A  is  simply 
(  t)o  displaced  by  some  J-vcctor  1 
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1-iKurv  7.  llliiMi.iiioii  4i|  Slitting  algonihm.  <r  aic  conUui  vertices 

The  Sliding  algorithm  needs  0(|<  dyr.s(.d)|  x  |«ij/os(/l)|)  operations  to  compute  for 

convex  A  and  B  This  is  not  optimal:  Section  H  describes  an  0(|»</</r.x-(.4)|  |  |»r/y« «(/?)))  algorithm 
for  this  task. 

The  Sliding  algorithm  derives  the  edges  oft  ’( >'/'(/()  from  the  interaction  ol  one  of  (a)  .in  edge 
of  B  and  a  vertex  of  A,  (b)an  edge  of  -d  and  a  vertex  ol  B,  or  (c)  an  edge  of  A  and  an  edge  of 
B  Similarly,  each  face  of  f  '0\}i:(B).  for  A  and  B  convex  polyhedra,  can  he  computed  from  the 
interaction  of  one  of 

a.  a  face  of  A  and  a  vertex  of  B  or  a  face  of  B  and  a  vertex  of  A, 

b.  a  (ace  of  A  and  a  eopl.niar  edge  of  B  or  vice  versa. 
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I  iRHU'  K.  tllti-Mainm  <»l  flu*  lVool  of  Hieoiem  ?  \m  loc.ihon  of  n  v  m  ilus  iasc  *  im  which  \  and  H  have  a 
ptnni  tn  uiinninii  (cxpicssihJc  ;t>  b  ;jjhJ  n').  gjjj  he  expressed  .is  <  /•  n  lluielou  <  '<  lb  •(  t)u 


c.  an  algo  of  .4  and  a  mm- parallel  edge  of  B. 

d.  a  face  of  .4  and  a  eoplanar  face  of  B. 


7.  Vector  Set  Sums  ami  (  onliguralion  Space  Obstacles 

I  lie  fundainental  result  of  this  section  is  the  following: 

Theorem  2:  l  or  A  and  B.  sets  in  5?  CO\''-(B)  =  B  0  (/\)0. 

l*r«of:  Iff  is  an  (j,  e)  configuration  of  A  then  (A),--  f0(4)<,.  Therefore,  if  a  £  (A),,  then 
«  o'  |  r.  where  a’  G  (4)m  see  figure  8.  1(  6  t£  /in  (/!),..  then  b  -  o'  |  c  and  therefore  c  —  b  —  a!. 
Clearly,  the  converse  is  also  true. 

I 

If  A  and  B  arc  convex  then  A  ©  1 1  and  A  0  B  arc  also  convex  [13  p.’)|.  therefore  ('O^'(B)  is 
convex.  Also,  for  B  and  A  in  their  initial  configurations, 

*  '<  V/'IMO  -  (Wo  O  (/«)u)  (  *  '(>T{(Bh) 
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I  mure  ').  Chararleii/alinii  nt  <  7  "'  in  icons  of  sol  addition  I  he  nolo  most  polspon  is  II  (hi  umeunost  is 
(  I  I  lie  diished  poheons  me  copies  ol  I  1)„  placed  ai  serines  ol  II  iheielou  die  comes  hull  of  inc 

iimel  poheon  and  lllese  dashed  pohgnns  is  C  7',"(/<)'|  (  l)u  h>  Iheoieni  I  Noli  dial  (  j  (  U»  /  H 

the  shaded  regions  aie  II  ((  '/ \''(/() '1 1  (  Mo) 

A  related  characterization  o f  CI"''(H)  is  also  possible,  l-or  c  ati  (x,y,c)  configuration.  if  r  £ 
Cl\',:(B),  then  e  0  C  B.  Since  is  the  set  o  fall  such  r.  then  ( 'l\it'(ll)  0  (/i)0  C  B 

and  furthermore  Cl”1' (II)  is  the  maximal  such  set,  see  (a)  and  (h)  below.  C'leai  1> .  \(  I)  --  .V  0  (A)o 
then  X  —  CI^''(B).  see  (c).  f  igure  8  illustrates  ilicse  results. 

Theorem  3:  l  or  A  and  li  convex  polyhedra, 

(a)  VX :  X  ©  (T)  o  C/)«A’C  CI\»*[B) 

(h)  r/f(/))©(4,cs 

(c)  C!rr(CO;»\(D))  =  B 

Note  also  that  Cl.\(B)  —  —CO,\(—B),  i.c.  for  A  to  be  inside  B.  it  must  be  outside  of  B  s 
complement 
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8.  M^orilluus  for  ( '(>'•>  (/?)  ;,„d  <  '<)\‘>(B) 

Theorem  1  provides,!  way  t»l  computing  ('(>"'  (II)  exacih  lot  convex  \  .uul  II  In  addition.  it 
provides  .in  approximation  technique  tor  ( ’(>\‘‘  (II)  when  A  .in J  II  .no  non  convex. 

Theorem  J:  l  or  poll  licdra  /I  and  B. 

ronv(A  ;[-//)  =-  ri»iv(A)  ©  amv(B)  --  nun  ( in  rl(A)  ©  vert(B)) 
where  conr(.Y)  dcnoies  the  convex  hull  '  of  set  A'  .nnl  verl(X)  is  the  set  of  \ei  liccs  of  X. 

Proof:  hist  show  th.it  cotiv(  1  ©  B)  -  r»nv(A )  © conv(B). 

Q) 

The  deiinition  ofcome.x  hull  stoles  th.n  any  «  (  nmv(A)  can  he  expressed  .is  .in  alline  combina¬ 
tion  of  points  in  A.  fills  may  also  be  done  for  am  b  £  nmv(B).  If  x  <5  ccmt  f.A)  ©  conv[B), 
a  G  co»»v(.-t).  b  G  conv(ll),  a,  G  A.  b,  G  B.  7,  —  I.  7,  >  0.  Pj  =  •  and  Pj  >  0  then 
x  =  a  +  b—  (7>,)  ©  6  =  y^-r,(a,  +  b) 

l  > 

=  ^  D','(D^a'  + 

1  j  *  '  j 

=  UU^(rt'  +  bJ ) 

I  1  1  J 

Itiit.  since  YhYlj~hPj  *  and  7,/?,  >  0.  x  is  an  alline  toiiihin.ilion  of  points  in  A  ©  I)  and 
therefore  belongs  to  its  convex  hull.  Therefore  conv(A)  (ft  cottv(B)  C  conv(A  ©  B). 

(C) 

If  z  G  cotw[A  ©  B).  then  Ibra,  G  A  and  6,  G  B. 

*  =  +  6’)  = 

i  i  t 

Therefore,  1  G  comi(T)  0  conv(B). 

This  establishes  that  conv(A  ©  B)  =  conv(A)  ©  conv(B).  Replacing  vcrt  (A)  for  A  and  verl(B) 
for/?  and  using  the  fact  that  conv(A)  =  c.onv(vcrt(A))  |13|.  shows  that  conv(vtrl(A)  ©  vrrt(B))  = 
r.onv{A)  ©  conv(B). 

I 

7  Phc  conu  t  hull,  com(-t).  of  a  nonempty  set  \  (  ft'1  is  {  ,  7’*,  I  x,  C_  t.i,  >  0,  t,  t.n  •  = 

1,2,...}  [13  p  1 5J  W'“ 
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Corollary:  I'or uunn  pohhedra  \  , inti It.  1<|i/f  nmr(/'i  r/(  1)  i  | 1  i<  >I(B))  in.  I  then-lore 
<  Y )\‘i:(D)  =  ami>(v<rt{H)  t.  >  i>rrf((.4)o)). 

Proof:  The  fust  pail  of  the  corollary  follows  directly  from  the  lad  that.  Im  convex  A.  A  ~- 
rimi;(.A).  The  second  pan  follows  from  Theorem  2. 

I 

Main  algorithms  exisi  lot  finding  the  annex  hull  of  a  finite  set  o I  points  on  the  plane,  e.g.  |9| 
1 1 7 1  1 1 5|  |29|.  |29|  also  deserthe  an  ellicient  algorithm  for  points  in  5?  1  I  liese  algorithms  are  known 
to  run  in  worst-case  time  0(nlog  t>).  where  v  ts  the  si/e  of  the  input  set  I  heiefore.  I  heoiem  -t  leads 
immediately  to  an  algorithm  lot  C()r'i:  and  an  upper  bound  on  the  umipuiuiionul  complexity  of  the 
problem. 

Theorem  5:  lor  com  ex  A,B  C  R*.  CO"r{B)  can  be  computed  in  time  ()(tr  log  n);  where 
n  |eer<(/A)|  -f-  |i>erd(#)|. 

Proof:  Hie  set  vert(B)  0  vrrf((/A)o)  is  of  si/e  |t»rrf(4)|  s  |trr<(/f)|.  ie  \ppl\mgaii 

O(o  log  r)  convex  hull  algorithm  to  this  set  gives  an  0(n2  log  ?i)  algonthm  loi  i .  •uiinw  <  '<■»"' '(/?) 
This  result  holds  only  for  convex  polyhedra  of  dimension  k  <  3 17). 

I 

I  he  algorithm  of  Theorem  5  is  not  optimal:  an  O(n)  algoi  Klim  exists  tot  (  '<  '  ( //)  when  .1  and  B 

.tie  convex  polygons8 : 

Definition:  rt(/A,u)  denotes  tlie  supporting  plane  (hue)  of  A  with  nutw.ud  uoimal  u  x(A,u) 
contains  at  least  one  boundaty  point  of  A,  call  it  a.  and  for  any  a'  t_  A  then  (a,  u)  •  (a.uy  I  Inis,  all 
ol  A  is  m  one  of  the  closed  half  spaces  bounded  by  ir(4,  u)  and  u  points  away  liom  the  mtciior  of  A. 

I.enuna  I:  If  A  and  B  arc  convex  sets  then 

*(A  0  B,  u)  n  (.A  e  B)  -  u)  n,A)0  (rr (B,  u)  n  /*)  (I) 


I'hc  development  in  this  seel  ion  is  based  on  that  in  Section  14  of  |4] 


IK 
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I  iKiiic  10.  Illii-.lialion  foi  l  emma  1. 

I  ciiwita  2: 

(a)  I  oi  n(<i\,a2)  ho  a  line  segment  and  b  a  point,  then  s(«i,at>)  (ft  b  -  ,s(ai  -)  b, a2  |  b)  is  a  line 
•cement  parallel  to  ,s(«i ,  a ,)  ami  of  equal  length.  See  figure  1 1(a). 

(M  I  et  *(ai,aj)  and  s(b\,b2)  he  parallel  line  segments  such  that  (<ij  <j|)  --  k(b2  —  bt)  for 
k  >  0.  Then  s(<i\,a2)  (|i  s(bub2)  —  a(a(  -f  6,,  a2  -f  b2)  and  the  length  of  the  sum  is  the  sum  of  the 
lengths  of  the  summands.  See  figure  1 1(b). 

riieorem  6:  l-'or  convex  polygons  A  and  /?.  CO'^D)  can  be  computed  in  worst  case  lime 
f>(|f-(rf(/l)|  |ueri(/?)|). 

Proof:  f  or  fixed  u.  each  term  on  the  right  hand  side  of  (1)  is  either  a  line  segment  (edge)  or  a 
single  point  (vertex),  it  follows  from  I  cimn.i  2  that  the  term  on  the  left  is  one  of: 

a.  a  new  vertex,  when  two  vertices  arc  combined; 

b.  a  displaced  edge,  when  an  edge  and  a  vertex  aie  combined  (I  cinma  2a); 
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c.  a  pair  of  displaced  end  toend  edges,  when  two  edges  aie  combined  <  I  omma  ?h). 

As  u  rotates counlcrclock w ise,  the  boundary  of  A  li  is  tunned  In  joining  a  succession  oi  these  line 
segmeiils.  Note  that,  heiaiise  of  the  convexity  ol  /I  and  H.  each  edge  is  eneounteied  exavtlx  once 

P  >31. 

A  polygon  is  stored  as  a  list  of  vertices  in  the  same  order  as  they  aie  eneounteied  In  the  mini 
lerclockwise  sweep  of  u  fins  is  etpn valent  to  a  total  otdei  on  the  edges,  fused  on  the  angle  that  the 
edge  makes  with  the  i  avis,  l  or  a  polygon  /’,  assume  the  j'h  edge  in  this  older. *(«»,,  t'j  ,  i). 
makes  the  angle  0},  then 


*(/\u)nr  = 


VJ- 

if  Oj  i  <  0(u)  <  0} 

CJ  ■ 

-*A 

-• 

II 

vJi  1- 

if  Oj  <  0(u)  <0j  f  i 

fhc  time  for  constructing  the  new  vertices  is  hounded  by  a  constant,  since  it  involves  at  most  two 
vector  additions,  finis  A  0  B  can  he  computed  in  linear  time  during  a  scan  of  the  vertices  of  A  and 
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Ticino  12.  Die  edges  of  II  -  (  t)«  when  l  ami  If  aie  annex  potxgnnv  are  found  h\  merging  ihe  edge 
lists  nl  II  and  (  l)n.  ouleied  on  lire  angle  then  normals  male  will)  ihe  posilne  i  axis 


II.  Figure  12.  An  implementation  of  this  operation  is  shown  in  Appendix  1  Simil.uly  B  Q  (A)o  can  be 
eompnied  in  linear  lime  by  first  converting  each  vertex  a,  to  rr.v  —  a,,  Figure  12. 

I 


When  A  and/or  B  are  non-convex  polygons.  COr^[B)  can  be  computed  by  an  extension  of 
the  algorithm  above.  ITic  metliod  relics  on  decomposing  the  boundaries  of  the  polygons  into  a 
sequence  of  polygonal  arcs  whose  internal  angles,  i.c.  the  angle  facing  the  inside  of  the  polygon, 
arc  each  less  than  ».  Ilic  algorithm  of  Theorem  6  can  then  be  applied  to  pairs  or  arcs:  the  result 
is  a  polygon  whose  boundary,  in  general,  intersects  itself.  ITic  algorithm  requires,  in  the  worst  case, 
()(\cdgc.*(A)\  X  |rdjrs(/f)})  steps (20J. 
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*>.  Dealing  nidi  dotations  of  A 

If  A  and  B  arc  polygons,  then  (fOt(/3)  is  an  object  in  52 denoted  I  lie  shape  of 

CO\fl0(f>),  when  A  and  B  arc  annex,  will  be  investigated  below  by  examining  changes  in  the  cross- 
scetions''  of  CO'"9  as  0  changes. 

Assume  a  fixed  value  for  0.  If  A  and  B  have  no  parallel  edges,  the  proof  of  Theorem  6  shows  that 
each  edge  of  CO\'‘(B)  can  be  expressed  as  one  of: 

<'  ~  bj  ©  s(<i,(0),  a,  H(0))  (2a) 

e'j  —  a,(0)  ®  s(bj,bj+l)  (2b) 

In  these  expressions,  bj  is  the  position  vector  of  the  jlh  member  of  vert(B)  and  a,(0)  is  the  position 
of  the  ilh  member  of  vert(Q(A)u).  which  depends  on  0.  The  order  in  which  die  a,  and  b3  are 
encountered  in  the  counterclockwise  scan  described  in  Theorem  6  determines  the  (t,  j)  pairings  of 
v  ertices  and  edges. 

liquation  (2)  shows  that,  for  small  changes  in  0,  the  e‘‘  rotate  around  br  while  the  e'1  arc  simply 
displaced,  Figure  13.  In  addition  to  these  changes  in  the  xy-cross-scction  ofCOy'fl.  there  arc  discon¬ 
tinuous  changes  at  values  of  0.  denoted  0*.  where  an  edge  from  A  becomes  parallel  to  one  from  B.  For 
values  of  0  just  greater  than  these  0,  this  pair  of  edges  has  a  different  order  in  the  scan  of  Theorem 
(>  from  what  they  had  when  0  was  just  less  than  0*.  Therefore,  the  (f,  j)  pairings  between  edges  and 
vertices  changes.  There  are  0(\<ilgcs(A)\  X  \cd<jcs(B)\)  such  0*  in  CO*su°. 

between  discontinuities,  the  lines  defined  by  c'j  edges  have  a  simple  dependence  on  0.  I  he  edge 
s(bj,bj+i)  is  on  a  line  whose  vector  equation  is:  (x,u})  =  (bj,  u})  where  u,  is  the  constant  unit 
normal  to  s(6j,  1).  I  ct  a,(0)  make  the  angle  0  T  r/,  with  the  x  axis,  with  rj,  constant,  and  Uj  make 

the  angle  tpj  with  the  x  axis.  Then,  the  equation  for  the  line  including  e*)  is 

(uj,x)  =  (uj,at(0)  +  b}) 

=  ||a,  ||  cos{0  -f  n,  —  <pj)  +  (bj,  Uj) 

Ihe  terms  arc  illustrated  in  Figure  14.  ITiis  equation  holds  only  for0  £  \<pj  —  f  |  —  p,]  between 
discontinuities;  but  within  that  interval  it  defines  a  plane  in  the  space  (x,  y,cos0).  This  spate  is 
analogous  to  that  defined  by  semi-log  graph  paper.  As  long  as  the  0-intcrval  is  known  and  cos-1  is 
*Thc  cross-section  of  for  constant  0.  is 


iK.ihm.'  will)  Ppi.jlmns  of  \ 


b* 


I  igmt  IV  <  '( is  (Ik-  umu’v  hull  of  the  imion  ol  crr/(*  ■(  1),^)  foi  each  h_  {  rtilili)  When  V 
land  (  l)»l  rolalcs  In  0.  the  <"  un.iie  around  />,  and  the  i "  .lie  ilr|>lined  When  an  <"  is  aligned  with 
an  I1'  I'm  some  0  ,m>  ccii.i  lolalion  mil  inieiehanee  the  ouler  in  which  ihc\  are  encountered  during  the 
coimleitlufltwi.se  scan  of  Ihcorcm  b 

single  valued  over  the  interval  then  the  mapping  from  (x,  y,  cos (?)  lo  (lie  (x, (?)  space  is  unique.  'Hie 
0-i.mgcs  can  always  he  chosen  so  that  this  is  the  case. 

The  c"  cannot  he  treated  in  a  similar  fashion  because  the  anaiitiiion  of  the  edge  changes  with  6, 
i.c.  the  equation  of  the  surface  involve  products  of  the  form  xcos0  and  yc.osO.  Instead  of  trying 
to  represent  them  exactly  by  noil-planar  surfaces,  this  section  develops  a  simple  approximation  tech¬ 
nique  that  avoids  dealing  directly  with  these  edges.  The  technique  will  he  illustrated  first  for  COzy 
and  later  for  CO**. 

l  or  fixed  0,  if  the  lines  defined  by  the  e'j  arc  extended  until  they  intersect,  the  resulting  figure 
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liKtiir  14.  Illustration  of  terms  in  equation  (3) 

completely  includes  CO"'(ll).  This  approximation  can  be  very  poor  when  the  angle  defined  by  ad¬ 
jacent  eh  is  very  acute,  see  f  igure  15.  The  approximation  can  be  improved  Ivy  introducing  additional 
lines  whose  normals  point  between  those  ofcJ_,  and  e'j.  These  lines  should  be  farther  from  bj  than 
any  of  the  e ''  paired  with  bj  in  (2a). 

This  method  can  also  be  used  to  approximate  the  slice  of  COJx"°(D)  between  discontinuities.  ITjc 
e'j  and  the  lines  to  bound  die  e'j  edges  both  define  planes  in  (i,  y,  cost?)  space,  sec  (3).  for  some  range 
of  0*  values.  Ihc  boundaries  of  the  0-intervals  also  define  planes  whose  equations  arc  of  the  form 
0  =  <t>j  —  rj,.  Ihcsc  planes  bound  half-spaces  whose  intersection  defines  a  convex  polyhedron  in 
(x,  y,  cos0).  This  polyhedron  contains  all  of  COsj'°  within  die  0-inicrval.  Therefore,  it  can  be  used 
to  approximate  COT^°  over  that  interval.  The  union  of  die  resulting  convex  polyhedra  for  each  0- 
interval  is  an  approximation  to  CO^yB. 

ITic  discussion  above  shows  how  to  build  a  set  of  n  =  \edges[D)\  -f  \vert(B)\  half  spaces 
hounding  COfJ'°(B)  within  each  0-rangc.  ITicsc  half  spaces  can  be  intersected  to  construct  a  convex 
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I  ittiin-  15.  \|i|no'  iniiiliiiu  (  '<  UMiig  onh  the  < ‘‘  woiU  well  ji  iiiifo  mi':  l.niv  imicmiu  angle,  but 

I'lmil;.  Ini  small  mkiim  angles  Ilie  lines  shown  dashed  can  he  Useil  m  ini|iio\e  the  appioximauon 

poh  hedron  m  (>(n  log  it)  i ii in1 1 7]  [.?()).  There  me  ()[\ctl<jts(  \)\  ■  |i  dg<  .s(/l)|)  0-ranges  that  need  to 
he  considered;  therefore.  (lie  eompleie  approximation  max  he  found  m  <  )(n  1  log  ri)  lime,  although  in 
m.iiit  applications,  a  eompleie  approximation  might  not  he  necessary 

I  he  same  icchniqnes  can  also  he  applied  to  computing  Clr"°(ll)  aiul  since  the  f’/  onh  lias  edges 
ol  the  form  (26).  the  resulting  pohhcdra  in  (x,  y,  cos 0)  are  an  exact  lepresentation  of  the  Cspace  \ 
entity  [20). 

This  approximation  is.  in  principle,  applicable  to  pohhcdra  in  .^-dimensions;  the  results  would  be 
a  set  of  pohhcdra  in  6-dimensions.  The  extension  is  conceptually  simple,  but  the  diflieulties  of  deriv¬ 
ing  and  representing  die  three  dimensional  orientation  eonstiainis  make  the  approach  unattractive. 
The  next  section  examines  an  alternative  to  dealing  with  the  high  dimensional  pohhcdra  required  by 
this  tec  hnique. 

10.  \pprn\imntiiig  High  Dimension  C space  Obstacles 

Section  3  introduced  the  use  of  projections  of  obstacle  slices  as  a  means  of  approximating  high 
dimensional  ('space  Obstac  les,  f  igure  16  shows  a  decomposition  of  C space ,  C  5?  *  into  a  family 


I'igurc  16.  z  slice  projections.  Hi  is  example  show  s  the  slice  projections  decomposing  ( ’space* 
into  tour  Cspaee* |%,  7,  +  i). 
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Appioviuialmg  High  Dimension  <  -/*//(  Obstacle- 


ol  slices  r’.sjxire  Tfj  ,  i],  I ich  of  these  new  Cspacc s  is  ;i  2  sliee  projection  ol  ('space  p  I  his 
new  family  of  spaces  is  .1  conservative  representation  of  the  ohslades.  i.e.  it  repiescnts  the  worst  case 
constraints  on  configurations  of/1  whose  2  coordinates  arc  within  the  range  |7j,Tj  t-t)- 

I  he  power  of  the  slice  projection  approach  is  that  the  family  of  dices  captures  all  the  constraints 
needed  to  plan  sale  paths  in  Ospnce \.  Having  all  the  slices  of  the  rO|(/l,J.  there  is  no  need  to 
refer  to  the  ( themselves.  O11  the  other  hand,  the  algorithms  in  the  Sections  ft  through  9  are 
tor  cross-sections  ol  CO  \(H),  c.g.  COJx!l  and  COTx'°.  not  for  slice  projection.  'I he  basic  result  of 
this  section  is  that  these  algorithms  can  be  used  to  compute  polyhedral  approximations  to  die  slice 
projections. 

The  construction  that  relates  slice  projections  to  cross-section  projections  is  the  swept  volume  of  an 
object.  Intuitively,  the  swept  volume  of/1  is  all  the  space  that  A  covers  when  mov  ing  w  ithin  a  range  of 
configurations.  In  particular,  given  two  configurations  for  A.  called  c  and  e'.  then  the  union  of  (/l)u  for 
all  c  <  a  <  c'  is  the  swept  volume  of  A  over  the  configuration  range  |c,  c'j.  ( ienerally.  c  and  d  differ 
only  on  some  subset.  A'.  of  the  configuration  coordinates,  l  or  example.  1!  r  and  c'  arc  of  the  form 
(di,  (3>,  (.it)  and  K  --  {.'{}.  then  the  swept  volume  of  A  over  the  range  |r,  r'),,  refers  to  the  union  of  A 
over  a  set  of  configmalions  differing  only  on  /?i.  The  swept  volume  of  A  mo  a  configuration  range  is 
denoted  A \c,d\^. 

Ihe  swept  volume  of  A,  a  rigid  object,  is  also  a  rigid  object10  w  nli  the  s.iiuc  number  of  degrees  of 
fieedotn.  l  or  linked  polyhedra,  die  situation  is  not  so  simple,  because  ol  the  interdependence  of  the 
Cspace  parameters. 

Note  that  for  a  linked  polyhedron,  the  position  of  link  j  typically  depends  on  the  positions  of 
links  k  <  j.  which  arc  closer  to  the  base  than  link  j.  Let  K  =  {j}.  c  —  (0,).  c'  =  (<?'),  and  | c,d\x 
define  a  range  of  configurations  differing  on  the  jlh  C space. \  parameter.  Since  joint  j  varies  over  a 
range  of  values,  links  l  >  j  will  move  over  a  range  of  positions  which  depend  on  the  values  of  c  and 
c',  as  shown  in  f  igure  17.  t  he  union  of  each  of  the  link  volumes  over  its  specified  range  of  positions 
is  the  swept  volume  of  the  linked  polyhedron.  The  swept  volume  of  links  j  through  n  can  be  taken 
as  defining  a  new  jlh  link.  The  first  j  —  1  links  and  the  new  j 1,1  link  define  a  new  manipulator  whose 
configuration  can  he  described  by  the  first  j  —  1  joint  parameters.  On  the  other  hand,  the  shape  of  the 


,nNi>tc  that  in  general,  the  swept  volume  of  a  poljhcdron  is  not  a  polyhedron  although  the  development  relies  on 
computing  polvhedral  approx imalions  to  it. 
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liuuii'  17.  ( 'liangos  ill  I  ho  -canid  joint  tingle  Ironi  0, 
I.,  and  link  !•) 
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lo  ff.t  causes,  changes  in  the  ooiiligiiintioiis  of  I'olh  link 


now  link  j  depends  mu  only  on  the  /^'-parameters  of  c  and  c'.  i.e.  Oj  and  0'y  hut  also  on  0[  for  /  >  j. 
I  his  implicit  dependence  on  parameters  of  c  and  c!  that  arc  not  in  h  is  undesirable,  since  it  means 
that  the  shape  of  the  new  jlh  link  will  vary.  I  citing  K  =  {j,  ,  «}.  then  the  shape  of  the  swept 

volume  depends  only  on  the  A'-parameters  of  r  and  c'.  while  its  configuration  is  determined  by  the 
(/  —  A') -parameters.  A  swept  volume  that  satisfies  this  property  is  called  displaceable. 

The  fact  th.it  the  swept  volume  of  a  linked  polyhedron  A  does  not  have  the  same  degrees  of 
freedom  as  does  A  forms  the  basis  for  the  relationship  between  slice  projection  and  cross-section 
projection.  If  the  swept  volume  is  displaceable,  the  /  --  K  parameters  may  he  changed,  but  changes 
to  the  l<  parameters  tire  not  legal.  Therefore,  the  Csjuia  of  the  swept  volume  of  A  is  of  lower 
dimension  than  the  C space  of  A.  In  particular,  configurations  in  Cspacc  \  that  have  equal  /  —  K 
parameters  and  whose  K  parameters  tire  in  the  defining  range  olThc  swept  volume,  project  into  the 
same  configuration  in  Cspace  qr  r<)K. 

If  A|c1c/]k  overlaps  some  obstacle  B  then,  for  some  configuration  a  in  that  range,  {A)„  overlaps 
B.  The  converse  is  also  true.  IM[c,  c']a  is  displaceable,  then  CO  q, ■,,•']*  (//)  is  the  set  of  I  K  projec¬ 
tions  of  those  configurations  of A  within  (c,  d ]k  for  which  A  overlaps  /?  fiquivalcntly.  CO \\,y]H(B) 
is  the  /  —  K  projection  of  the  [c,  slice  of  CO ,(//).  If  the  configurations  of  the  swept  volume  arc 
one  of  (x,  y),  ( x ,  y,  z ),  or  (x,  y,  0 )  then  the  algorithms  of  the  previous  sections  can  he  used  to  compute 
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( '(  » i  (/{)  and  tlierclix  t  outputs' the  isqmicd  slit  c  projections11  . 

\  loiiii.il  -.i.iK  iiu  ni  .ind  proof  of  this  k-siiIi  is  im. liuis'il  in  \ pp  -iul i \  ’  .is  1 1 1 .•  1 1 1 s' 1 1 •  S  I  Ins  theorem 
is  ul  pi.niis.il  itiipoitansc  sms  s'  il  pro'  isls's  the  nisi  li.inisin  inislsi  1  >  mo  ills'  I  nidsp.uc  .nul  lindp.ilh 
implementations  sls'ss  i ills'll  III  I'(t|  .lllsl  |21].  111  .Islsltl K ill.  tils'  pio.il  sit  Ills'  llls'ols'lll  demons!  tales  ills' 
usefulness  of  tils’  C'.s/xicf  concept  .is  a  tool  in  theoretical  .in.il>  sc-  of  sp.iti.il  pi. inning  problems. 


II.  Kclau-il  Work  in  Spatial  I’laiining 

I  Ik-  definition  of  the  I  imlsp.it  s’  probls'm  used  here  is  basal  on  ih.it  in  |4h).  Approaches  tti  this 
piohls'in  .us-  sls'ssi  lin'd  In  1 1’|  .uni  |77|  Ills'  latter.  \s  Ills'll  is  tils'  more  i  s'ls's  .nil.  is  an  application  of  the 
Warnock  algotiilmi  tor  hidden  lino  elimination.  It  invohs’s  isviirxi'ely  subdividing  the  workspace  un¬ 
til  an  aie. i  "l.n vis'  s’ltotigir  lor  (ho  olijs’it  is  found.  I  his  .ipproacli  lias  seu’ial  drawbacks:  I ) )  any  non- 
i >\ s' i l.ippi in’  snbdiMsion  strategy  will  break  tip  potentially  useful  areas.  and  (7)  the  implementation  of 
the  pre'dit  ato  "I, ugo  enough”  is  not  specified. 

I  lie  <  ’.•i/Hii'c  approach  to  I  indspace  and  I  tmlp.it h  described  here  is  an  extension  of  that  repot  ted 
in  I'll  In  that  papoi  an  appioxnnate  alj’.ot Him i  for  (  T(  (li)  is  described  and  the  Vgraph  algoi  ithin 
lor  high  dinieiisional  I  inslp.it li  is  first  presented. 

Hie  basis  idea  of  repieseniing  position  constraints  as  gs'otiieinc  figures.  e  g.  ( ’()'"(/?),  has  been 
used  (independent!' )  in  |l|.  |2|  and  1 1).  who  employed  an  algorithm  to  compute  ( 'O'7'  for  non  convex 
polygons  in  a  icclinii|ue  for  two  tIimension.il  layout.  Ihe  template  packing  approach  described  in 
|I0|  uses  a  related  compulation  based  on  a  chain-code  description  of  figure  boundaries.  (Uij  reports 
algorithms  for  packing  of  parallclopipeds  in  the  presence  of  obstacles  using  a  construct  equivalent  to 
the  CO11',  but  defined  as  "the  hodograph  of  the  Close  Positioning  I  unction”.  I  he  only  use  of  this 
construct  in  the  paper  is  tin  computing  COtu  for  aligned  rectangular  prisms. 

Ihe  work  by  Utltipa.  reported  in  |4<l|  |4I|,  was  the  liist  to  approach  I hulpath  by  explicitly  using 
transformed  obstacles  and  a  space  where  the  moving  objs’cl  is  a  point.  Iklupa  used  only  rough  ap¬ 
proximations  to  the  actual  Coxier  obstacles  and  hail  no  direct  method  for  representing  constraints  on 

"Of  course  this  icignies  tnmpiiimp  a  rons cs  pnhltt-dial  approximation  lo  the  swept  xoIuiik-  ol  t  Simple  appnnimationt 
ate  not  dilVieiill  lo  compute  |’()|  lull  this  is  an  aie.i  when’  lu-llei  alpotillims  are  letpmeil  Nevertheless.  ihe  swept 
uihmie  eom|Uil.ilioii  is  a  1  tlimensional  operalion  whit'll  tan  I'e  defined  amt  exeeuled  wilhoiil  reetuuse  lo  (>  dimensional 
constructs 
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more  than  three  degrees  of  freedom.  (41]  also  surveys  previous  heuristic  .ippro.iches  to  the  I'mdpath 
problem  for  manipulators  |)7|  [28]  |44J.  An  early  paper  on  Shakey  |25)  describes  a  technique  for 
I'indpath  using  a  simple  object  transformation  that  defines  safe  points  for  a  circular  approximation 
to  the  mobile  robot  and  uses  a  graph  search  formulation  of  the  problem.  More  recent  papers  on 
navigation  of  mobile  robots  are  also  relevant  to  2-dimensional  lindpath  (1 1  ]  |23]  [39].  [  1 4]  reports  on  a 
program  for  planning  the  path  of  a  2-dimensional  sofa  through  a  corridor.  This  program  docs  a  brute- 
force  graph  search  through  a  quantized  C space. 

[31]  proposes  an  extension  of  the  approach  in  {21}  to  the  general  l  indpath  problem,  but  using 
an  exact  representation  of  the  high-dimensional  Cspuce  obstacles.  The  basic  approach  is  to  define 
the  general  configuration  constraints  as  a  set  of  multinomials  in  the  position  parameters  of  A.  But. 
the  proposal  still  requires  elaboration.  It  defines  die  configuration  space  constraints  in  terms  of  the 
relationships  of  vertices  of  one  object  to  the  faces  of  die  other.  This  is  adequate  for  polygons,  but 
the  equations  in  the  paper  only  express  the  constraints  necessary  for  vertices  of  A  to  he  outside  of  B. 
i.c.  dicy  arc  of  the  form  of  (3)  above.  They  do  not  account  for  the  positions  of  A  where  vertices  of 
B  arc  in  contact  w  ith  A.  Thus,  the  equations  do  not  represent  the  correct  constraints  on  the  position 
of  A.  The  new  equations  will  have  terms  of  the  form  a-co  sO  and  ycosl?  I  urtheinioie  the  approach 
of  defining  the  configuration  constraints  by  examining  die  interaction  of  voiticcs  and  lutes  docs  not 
generalize  to  .Vdimcnsionnl  polyhedra.  It  is  not  enough  to  consider  the  miciutiion  ot  vertices  and 
faces;  die  interaction  of  edges  and  faces  must  also  be  taken  into  account  |fi] 
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kppentlix  I.  \lu«»t ilfim  for  ( '< 

this  appendix  shows  .in  algorithm  tor  A  >  /f  SL I  SUM(  A,  U)  when  \  .mil  /<  me  convex 
polygons.  Section  5  shows  how  this  operation  e.m  he  used  to  compute  COJU. 

I;.ach  polygon  is  described  in  terms  of  its  \ertiees  mid  the  . ingles  that  the  edges  make  with  the 
positive  i  axis.  I  hc  edges  and  vertices  are  ordered  in  counterclockwise  order,  i.c.  In  increasing  angle, 
file  polygon  structure  in  the  following  program  has  the  following  components: 

1.  size  —  number  of  edges  in  polygon. 

2.  vert  [O.size]  —  an  array  of  vectors  representing  the  coordinates  of  a  vertex.  The 
ilh  edge,  t  =  I,  ...size,  has  the  endpoints  vert[i-l]  and  vertfi].  Note  that 
vert[0]=vert[size]. 

1.  angle  [0:size]  -  the  angle  that  the  normal  of  an  edge  makes  with  the  x  axis, 
nionotonically  increasing.  I  or  convenience  angle[0]=angle[size]. 

flic  algorithm  follows  directly  from  Theorem  6.  noting  that  in  this  representation  of  polygons, 
edges  are  represented  In  successive  vertices. 

St  I -SUM  (a.  b) 

{  c  -  new-polygon  (a. size  +  b.size);  /•  create  new  polygon  of  max  size  * 
ea  =  1 ;  eb  =  1;  vc  =  0:  ang  =  0;  offset  *  0; 
do  {  ea  =  ea  +  1  } 

until  (a.angle[ea]  >  =  b.anglefl] 

and  a.anglefea  -  1]  <=  b.angle[l]) 
c.vert[0]  *  a.vert[ea]  +  b.vert[0]; 
do  {  vc  *  vc  +  I; 

ang  =  offset  +  a.angta[ea]; 
i f  ( ang  <  =  b . ang 1 e[eb]) 

then  if  (ea  >  a. size)  /*  handle  wraparound  V 

then  {  offset  =  Zpi:  ea  5  1;  } 
else  ea  *  ea  +  1; 
if  (ang  >=  b.angle[eb]) 
then  eb  »  eb  ♦  1; 

c.vertfvc]  =  a.vert[ea]  +  b.vertfeb]; 

} 

until  (ea  *  a. size  and  eb  *  b.size); 
c.size  *  vc; 

> 
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lijjKTV  AIK.  llliiMiation  of  the  definition  of  <h/v(r,r')  and  Oh(c,c') 


Appendix  2.  Proof  of  Theorem  8 

Assume  that  C space, x  C  5?rf.  let  /  —  {1,2,...,  rf}  and  K  C  /.  /.  /f  and  ]  K  sltall  denoic 
sets  of  indices  for  the  coordinates  of  a  (=  Cspace.\.  Define  the  following  vectors,  all  in  CspaccA : 
6  —  (/3,),c  =  ('?,)  and  o'  =  (Y,)  fort  £  /.'llicn, 

♦h(c,0  =  { 6  G  sr'  I  A  Tfc  <  A  <  Vfc} 

fcGK 

4>a(c)  =  <1 >a(c,c) 

@h(c,c')  =  <Mc.  cOn^-^e) 

I  hesc  definitions  arc  illustrated  in  Figure  A18. 

1310  projection  operator ,  denoted  >-•  1  is  defined,  for  vectors  and  sets  of  vectors,  by  : 

PK\b\  =  ((3k)  k£K 
Pn\D)  =  {rh\b}\bGB) 


Superscripts  on  vectors  indicate  projection,  e.g.  bh  —  P/v  ( 6  ] .  In  addition.  the  vector  in  Jf1'1  com¬ 
posed  front  one vector  in  3?|,v'  ;ind  one  in  *' 1  is  denoted  (a1  lx  b1').  where  /’/  a((h/'  /l  .  6jl' )  ] 
a1  h  and  l\ \  (a1  h  :  bh )  ]  =  bh . 

In  this  notation,  precise  definitions  for  the  notions  of  cross- section  projection  and  slice  projection 
can  be  provided.  The  cross-section  projection  of  a  Cspacc  ,  obstacle  is  vv  mien  as  follows: 

ro^n)\c}h  ~  p,  A|ro,(/j)n*A(c)l. 

The  slice  projection,  is  similar  to  the  cross-section  projection,  but  carried  out  for  all  configurations 
between  two  cross-sections: 

rOt(«)(c,e'|/v  s  /,/.-a|CO,(«)iT*a(C,<0). 

The  /^-parameters  of  the  two  configurations,  c  and  P .  define  die  bounds  of  the  slice.  Similarly,  the 
swept  volume  can  be  defined  in  this  notation: 

Definition:  The  swept  volume 12  of  A  over  the  configuration  range  |c,  r7]/,  is 

(A\c,PU^  U  (A)a 

I  he  requirement  discussed  in  Section  10  that  the  swept  volume  of, A  be  ihsphiuitblc  is  embodied 
in  the  follow  ing  condition: 

Vn .  h  zh)  ~~~  ]h  )(ut  r* )  (4) 

Note  that  the  /  —  K  parameters  may  be  changed,  as  in  (-1).  but  not  those  parameters  in  K.  I  herefore. 
(T|e,  <-']/,  )„  is  defined  only  if  a  £  4>a(c). 

lemma  3:  If  (1)  holds,  i.e.  if  the  swept  volume  is  displaceable,  then 

/»/.-h(co.4|r.I-u(/?)n*h(f)]  =  r,  A I  (CO  ,(fl)00A(o,e,-c))n  ♦»!■(€)]. 

17  the  similarity  in  the  notation  between  swept  volume  and  slire  projection  does  not  imply  an>  direct  iclalionship 
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I ’roof  of  I  Minina: 

(2) 

1 1  a  6  /v|(OO((/3)©0/k(O,  o'— c))n^K(c)|,  then  there  exists  an  (a1  h  i',1)  6  CO\(B) 

ami  an  ii  £  ©a  (0,  c'  —  e)  such  that  x['  —  z!}  =  c1' .  This  implies  that  i\  G  4>a  (c,  d).  Then,  using 

(4). 

(-4 )(, 'v  xf )  Q  (/l(c, e']/x)(„/-h  :rH). 

Hut  sinee  (a,“,k  :  x[' )  £  CO  \(B).  then  (/!)(„;-  k  ;k  ■,  intersects  B:  therefore,  its  supersets  also  inter¬ 
sect  B.  IH  the  definition  of  CO 

:  ch )  G  COM<,(J|h(i?)n<l>/,(e)  =.a£P,  a  I  CO  M,,.u(/J)  D  4>a  (c)]. 

(Q 

Assume  a  £  (C0llr  ri|K(/?)  fi  4>/v(c)];  then. 

{A[c,  <?\h  )(0/-s  ;  cK )  n  B  9 

f  or  all  x  £  0A(O,c'  —  c).  ( a’~h  :  cK)  -f  x  £  ^(c.c')  and  /*/_/*(  (o' :  ch)  -f-  i)  =  a1  . 
therefore.  by  (4) 

(•^ )(« ’ ~  K  rK  )  t 1  (<4|c,  C  ]/x  s  CK  )• 

Since  these  are  all  the  sets  dial  make  up  tlte  swept  volume,  at  least  one  of  them  must  also  overlap  B 
when  the  swept  volume  docs;  therefore  there  must  be  some  x\  £  ©a  (0,  d  —  c)  for  which 

(/4)(oi-*i  nfl  ^  9. 

liy  the  definition  of  CO, 

(o'"''  .  ch)  +  r,  £  COa(B)  «  {a’~h  :  ch)<=  (COA(B)  -  0K(O,  d  -  c))  D  4 >*(e). 
Gcarly,  then 

O  6  P,  -  A  |  (COa(B)  -  ©*  (0,  d-c))tl  4>a  (c)  1 

I 

Ihis  I  emma  leads  to  a  proof  of  'ITicorcm  8. 
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lltmvniK:  It' (l)  holds,  then 

/Vk|^(B)0‘1>k(c,c'))  =  Pi  -h|COllPif.)k(B)n*K(c)] 

Proof  oMhcorcm: 

1  he  proof  below  shows  that 

h  -  K I co rn n 4>/s (c, d) l  =  r,-h\(coA(D)  © ©h (o, d  ~ c)) n ♦*■(«)]. 

Hie  theorem  follows  directly  from  this  result  and  l.cmma  3. 

(C) 

If  a  G  Pi  -k  l  CO  ,(fl)  n  4>/.  (c,  o')  ].  then.  for  some  x  €  0/v  (0,  d  —  c)  there  is  an  a,  such  that 
a,  -  (a'-K  :  ch  +  x1')  E  COA(B)  n  **(c,  d) 

Since  i'"1'  =  0.  then  a,  —  x  €  ‘K(c)  and  therefore 

«,  -  x  G  (CO.\(B)  ©  ©K(0,  c'  —  c))  O  <*>h  (c). 

Since  a  =  P/-h|oi  ~  x\ 

a  e  P,-  h  |(ca,(B)  0  e,t  (0,  c'  -  c))  n  ♦*•(*))■ 

Q) 

Assume  a  E  Pi  -  h|(CO.t(B)  ©  0k  (0>  ^  ~  c))  fi4>h(c)],  then. 

(a,-A  :  c,v )  G  (CO\{B)  ©  0K(O,  d  -  c))  fi  <M4 

Since  tire  /  —  K'  parameters  arc  not  changed  by  the  set  subtraction,  there  must  be  an  ai  = 
(a'~  ,s :  r,' )  G  CO  \(B).  x\  must  be  in  4 >h(c,d).  because  Pk  ]xi  —  x^]  =  c  with  xj  G  0k (0,  c*  —  c). 

(o'-K  :x|')  €  COA{B)n*H{c,d)  =»  o  G  P/ - h I CO,\{B) ft ♦«{«. <0 1  • 


